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Preface 

The report attached as Appendix A documents the research performed by the School 
of Aeronautics and Astronautics, Purdue University, for the NASA Ames Research 
Center/Dryden Flight Research Facility, under Cooperative Agreement/Grant Number 
NCC2-288*. The objective of the program was to determine the applicability of several 
multi-input/multi-output control synthesis techniques for the synthesis of flight control 
laws for advanced experimental aircraft, and to extend the techniques as necessary to 
obtain simple, robust control laws that meet specific handling qualities objectives. 

This report includes results from the synthesis of control laws for an advanced 
STOL vehicle in a low-speed approach flight condition. Two of four candidate synthesis 
techniques are reported herein - direct eigenspace assignment and explicit model 
following via a Linear Quadratic Regulator (LQR) formulation. The other two 
techniques under current investigation, but not considered as part of this grant activity, 
are implicit model following (also via LQR) and Cooperative Control Synthesis. This 
latter technique has been a topic of continued research at Purdue University, and utilizes 
pilot-in-the-loop (pilot modeling) techniques. 

A fundamental objective in this work was to obtain low-order feedback 
compensators, synthesized via the techniques above, and judicious use of state-estimation 
thus allowing the use of a reasonable number of sensors for feedback. Although this 
report focuses on the results from the synthesis of state-feedback control laws, two state- 
estimation techniques under consideration are also noted. In implementing these 
estimation techniques, we are interested in the ultimate stability robustness of the system, 
and not increasing the dynamic order of the stick-response transfer functions. The latter 
goal is motivated by the desire to preserve the handling characteristics "built into" the 
state-feedback control law utilized. 


* Mr. E.L. Duke, Technical Monitor 
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1. INTRODUCTION 

The ultimate performance objective of the flight control design is 
to make the comb ined pilot and vehicle system behave suitably. This 
objective introduces the idea of “handling qual i t i t i es“* defined as 
those desirable dynamic traits of an aircraft that will help the pilot 
and vehicle system perform their intended mission. With the “handling 
qualities" specifications available to the control system designer* he 
must use these specifications to formulate and implement the control 
system design* and finally to ver i f g that the augmented vehicle does 
indeed meet the handling qualities specifications. 

In the past decade or so* many new methodologies for designing con 
trol systems for multi-input multi-output systems have emerged. The 
objective of this study is to investigate the applicability of some of 
these 'modern' techniques to design of flight control systems* with the 
specific objective of meeting the handling qualities reqirements. 

In this particular study* two of these techniques — direct eigen- 
space assignment (DEA) and explicit model following (EMF)* are used ini 
tially to synthesize control laws for the logitudinal dynamics model of 
a STOL vehicle in the landing approach conf igurat ion. The vehicle model 
and the flight control design requirements are presented in Section 2. 
In the succeeding sections* the two synthesis techniques are briefly 
discussed and the handling qualities specifications mapped into the 
algorithm formulation. The control laws resulting from exercising the 
algorithms are evaluated in terms of achieved performance and robust- 


ness. 
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Since the synthesized control laws involve full-state feedback* 
methodologies for implementing these control laws using output feedback 
and without adversely affecting performance and robustness* are a topic 
of significant interest and are presently being pursued. Promising 
techniques being considered are briefly discussed in Section 5. 

Finally* the salient features of the two design techniques are sum 
marized and the areas that require further investigation are suggested. 
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2. 1HE STUDY VEHICLE 


J>. 1 Vehicle Model Description 1 

The vehicle considered is a STOL aircraft* with an airframe similar 
to an F— 18 aircraft. The linearized dynamic model for the longitudinal 
axis includes four rigid-body degrees of freedom and three first order 
actuator lags (each at 15 rads/sec). The trim values for the landing 
approach flight condition are listed in Table 2. 1. The control inputs 
to be utilized are the horizontal tail (elevator)* the thrust vector 
angle for a 2-D nozzle* and the trailing edge flap. The state vector for 
the vehicle model is 

% * i %, Sh, ] 


where 


ft 

1/ 

6 


Ut 

= nond imensional forward speed ( > 

= angle of attack (rads) 

= pitch rate (rads/sec) 

= pitch angle (rads) 

= horizontal tail deflection (rads) 

= Thrust vector angle (rads) 

= trailing edge flap deflection (rads) 


with the control inputs taken as commands to the servo actuators* or 



Wc , ^Fe ] 


The vehicle responses of interest are 

f-b 


where 



"Og. ■= normal acceleration at C. G. <g's» +ve up) 
Tf *= flight path angle (rads) 


4 


The vehicle dynamics can then be written in the form 

•z -Ox + 8 ? c 
l -Cx 

The open loop system matrices are listed in Table 2.2. The open-loop 
vehicle eigenvalues are 

^ a = 0 .| 557 + ; 0-1962 , >^- 1-53 5 , ^ s 0-8532 

Note the unstable pole. 
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and and selected so as to satisfy Level 1 handling qualities 
requirement Cl] and a rise time for pitch rate* “0.8 sec. Further- 

V 

more* the augmented vehicle should exhibit classical "phugoid" like 
dynamics for the loui frequency mode. 

In the present study* our primary objective will be to meet the 
above handling qualities specifications through proper control augmenta- 


tion of the vehicle. 


Table 5. 1 Trim values for STOL model 
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3. DIRECT EIGENSPACE ASSIGNMENT ( PEA ) 

3. X. Gain Sunthesis 

In the direct eigenspace assignment technique* the control objec- 
tives are stated in terms of a desired eigenstructure for the augmented 
system. For the state feedback case* the synthesis problem is as follows 


Given a system 


= /'*+ 6 f <sust 


7*\ 


W- - + Up 2 u. £ ft 


Up = pilot's control inputs 

'i * cz 7 l 6 


ystem dynamics) 


(total control input) 


(system responses) 


find a control law of the form 


U t - - K * 


to achieve some desired eigenspace for the augmented system 

S =(/*-£ 10 2 + 8 w p 
!)■ c * 

To determine K* note that the augmented (closed-loop) system eigen- 
values and eigenvectors are related by 

(A-BK) \ -- > Ci V'i c-i, . n 


( 3 - 1-0 


where 

£ = closed— loop eigenvalue 
V r = closed-loop eigenvector 

L l 

For full— state feedback* the limitation on the achievable eigen- 
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space is that all the desired closed-loop eigenvalues can be exactly 
placed while only "m" elements of their associated eigenvectors may be 
specified (where m *= dimension of ll). Since in general m < n* we cannot 
exactly obtain all elements of the desired eigenvector for each closed- 
loop mode. One approach is to determine the "best" achievable eigenvec- 
tor * for each of the closed-loop modes* that minimizes the mode's 
cost function 

'KV’O’X- (V**.-) (3K '° 

where 

= i 'th achievable eigenvector associated with eigenvalue 
^ *= i 'th desired eigenvector 

= i 'th n-by-n symmetric positive semi-definite weighting 

(A I 

matrix on eigenvector error elements 

and * denotes conjugate transpose. 

Equation (3.1.1) can be rewritten as 

Defining the vector Of- ~ -kV and using eqn. (3. 1.3)* the solution to 

l a L 

(3.1.2) is obtained as 

\ a <*c L < ^ ^ ^ ] 

where L[ - ( % $ ~ A") B> . 

Once id' are obtained* the achievable eigenvectors are given by 

\ - Li ^ 

and the feedback gains are obtained as 

K = -VJV~' 



where 
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W = [**, ^2 • ■ ^ 1 

and __ _ _ __ 

V r [ H, ^3 • : ' • J 

This solution algorithm is due to Schmidt and Davidson C23. A 
macro using MATRIX.. commands uias written to implement the above syn— 
thesis procedure. This macro is documented in the Appendix. The block 
diagram for DEA control law implementation is shown in Fig. 3.1. 

3. 2 Selection of Desired Eiqenspace and Resulting Control Law 

The control design objective is to make the augmented vehicle modes 
like those of a "classical" airplane i. e. the phugoid and short period 
modes. For this initial synthesis! we chose the desired phugoid mode to 

= O' 3,5 JkadiA jA@C > ~ ^ 

■=#» ^ = -o-d5±$ 0-W8 7 

with the corresponding desired eigenvector selected as 

- [ I £ ^ , 0 > a , ^ > a > a > {*o4z fl b-h ff 3) 

where "a" denotes an arbitrary value. The above choice for the phugoid 
eigenvector reflects the desire that the phugoid mode shape be dominated 
by forward speed and pitch attitude response with little or no angle of 
attack contribution C43. 

The short-period mode frequency and damping are selected to reflect 
the handling qualities requirements. This choice is as follows 

LO dfx - 3'7 Ao/6 jM<. j r 

=* \ - 3 78 ± £ 2^3 

The choice of the desired short-period eigenvector is based on the 
requirement that the short-period mode be dominant in angle of attack 
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and pitch rate response* with little or no forward speed contribution. 
Furthermore* the short-period eigenvector should reflect the desired 
flight path angle to pitch attitude phase relationship i. e. we want 



Using the relationship ~f = Q - o( * we can write the above constraint as 



With and -3-76 T ^ S , ue get the desired relationship 

between 

0( and *p in the short-period mode to be 

f"/ - -0- 18 ) + j 0-303& 

% 1 ^ * 

Then an eigenvector that results is 

vl -- \o, -0/8I+ }0-3oU, I, (ho{<L 

The above choice as well as the desired eigenspace for the actuator 
modes is listed in Table 3. 1. The actuator poles are left near their 
open loop values* and the corresponding eigenvectors are selected simply 
to obtain decoupled actuator modes. 

From Table 3. 1 we note that for the short period mode and for all 
the three actuator modes* we are in effect specifying only three ele- 
ments of the corresponding eigenvectors. Since we have three controls 
available, we shall be able to exactly achieve the specified elements of 
these eigenvectors. The phugoid eigenvector effectively has only two 

specified elements. This leaves one extra degree of freedom to further 

constrain the phugoid eigenvector. One possibility to be explored in 
the future is to use this freedom to reduce the control surface deflec- 


tions. 
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The achieved eigenvectors corresponding to the above selections are 
listed in Table 3. 2, and the associated feedback control gains in Table 
3.3. As we expected* the desired eigenspace is achieved exactly. For 
comparison* the phasor diagrams for the open-loop and achievable eigen- 
vectors are shown in Fig. 3.2. These indicate "classical" phugoid and 
short-period mode like behaviour for the augmented airplane. Note* how- 
ever* the large control deflections in these mode shapes* indicating 
high deflection requirements for this control law. 


3. 4 Performance Evaluat ion 

With the pilot's input taken to be commanded horizontal tail 
deflection (<^Hp c )» the transfer functions between the responses of 
interest and the pilot's input are listed in Table 3.4. These transfer 
functions indicate that the augmented system response exhibits the 
desired decoupling between the phugoid and the short period mode. More- 
over. when calculated from these transfer functions for 2-7^ does 
give the value (-0. 181 + jO. 3038) that was specified during the design 

process. Also in the y£ u transfer function, note that has increasd 

^ -i ' % 

to O. 92 from its open loop value of 0. 5 sec . 

Other responses of interest are the normal acceleration at the 
center of rotation (”^2 } and the flight path angle at the center of 
rotation (Ar.). With the horizontal tail deflection as the only pilot 
input* the center of rotation is located 10. 45 ft ahead of the C. G. The 
transfer functions for these responses are also listed in Table 3.4 

The transfer functions from pilot's control input to the actual 
control deflections are listed in Table 3.5. 

Time histories for a step pilot input ( •= i ) are shown in Figs. 
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3.3 to 3.5. Fig. 3.3 shows the response for the augmented vehicle states 
- these again indicate the decoupled phugoid and short-period mode 
behaviour. Fig. 3. 4 shows the response for normal acceleration and 
flight path angle* both at the C. 0. as well as the center of rotation. 
Fig. 3.5 shows the actual control deflections for this step pilot input. 

3- 5 Robustness Eva 1 uat i oh 

A very important consideration in flight control design is the sta- 
bility robustness of the augmented system. Given a system with transfer 
function matrix G(s)* where ( 

G,CO -fa 4- A] b 

a reliable (but sometimes conservative E53) measure of robustness is the 
minimum singular value of the return difference matrix* evaluated as a 
function of j UJ , or in this case* with the loop broken at the input* 

Cf [4 + K (■*) 3 

For the control law obtained above* the singular values of the return 
difference matrix are plotted in Fig. 3.6. Note the relatively low sta- 
bility margins in the frequency range of upto 4 rads/sec (the frequency 
range of the veh i c 1 e* ex cep t for the actuators). How to increase this 
robustness requires additional consideration. 

A more "classical" approach to evaluating the stability robustness 
is to "break" one loop at a time (i. e. one loop open and the other loops 
closed). The eigenvalues of the system with the various loops open* and 
for the above control law* are listed in Table 3.6. (Note that the sys- 
tem with loop open has one unstable pole* which means that the con- 
trol law will not be able to stabilize the vehicle in case of an eleva- 
tor actuator failure). The Bode plots for the one-loop-at-a-time 



14 


analysis are shown in Figs. 3. 7(a)-(c). These plots appear to indicate 
"good" gain and phase margins in all the three control loops. This 
might be optimistic in light of the stability margins based on the 
singular value analysis. Whether this controller has sufficient robust 
ness is an open question. If not* how to improve robustness is a topic 


of interest. 
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Table 3.5 Control deflection Transfer functions for DEA desi 
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Figure 3. 2 Eigenvector Phaser Diagrams 
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Figure 3.7(a) Bode plots for loop open 




28 



Figure 





Figure 3.7(c) Bode plots for loop open 


4- EXPLICIT MODEL FOLLOWING ( EMF ) 


5.- 1 Gain Sunthesi s 

In the LG explicit model-f ol lowing algorithm* the problem formula- 
tion is as follows 

Given vehicle dynamics 


7 L V - 'A v ^ v + U 

2-w - 


where 2^ is the vector of vehicle responses to be controlled* and 
desired system characteristics in the form of a state-space model 

^-'YV\ ' A-nr, ^*w. + B-y- S\ 


"H\ 


Tn 


^rn ' C y r \ 


; 7r> t 


where = pilot stick input modelled as 


s* - 't 8 -** + i u,f 




\l4Jk 

VJ 


we want to determine LL to minimize 

I E - E j U-, | j r [( £ v - 6?J "0 + dt > 

T-2> o 

Combining the vehicle dynamics and the model dynamics* we get 
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Writing the augmented state vector as 
definitions of the matrices A* B* C and D* we can write the combined 
system dynamics as 


jand with appropriate 


% ^ f\ 7. + 6 U + D 
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and 3^. can be written as 

T „ E 5^ T i [^ T t T 6) ? tx + U T Rw] ? 

£ 'T -*G0 ° 

The problem is now in the form of a Linear Quadratic Regulator (LQR ) and 
the resulting control law is C63 




wi th 


K = R'VP 


*v 

y~-n\ 


and P ^ O and symmetric* the solution to the algebraic Ricatti equation 

/fp + ffl+ c T s*c - P6K"’6 t p • o 

The block diagram for EMF control law implementation is shown in Fig. 

4. 1. A macro using MATRIX^ commands for the synthesis of the EMF con- 
trol law is documented in the Appendix. 

The augmented system results in the following state— space represen- 


tation 
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3.. 2 Model Selection and Resulting Control Law 

The vehicle state-space representation is as in Section 2.1 with 
all the three inputs < £ H( . t £ F ) and the vehicle responses to be con- 
trolled. ]. 


With the handling quality criteria stated in terms of desired short 
period response for the augmented system* we have 
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In the state-space form* this model can be represented as the third 
order system 
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With /c v = l, 3,7 Mfk/MLc , j>* O'VsTj ? &3 = 0'7Smc and fy* 5-133 


. (based on stick gradient of l°/lb)» the numerical values 

of the model system matrices are listed in Table 4.1 

For the purposes of the following control law synthesis* the stick 
time constant £p r 0 ' ^ j 

and the output error weighting matrix 0=1 were chosen. The 


control weighting 

matrix R 

was chosen 
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where subscript "max" refers to the maximum allowable deflection. As 
the "control authority" is increased (scalar weighting § is decreased)* 
the crossover frequency of the loop transfer functions EL will 

increase. Higher loop cross-over* in general* relates to a higher 
fidelity match of the vehicle and model. However* higher crossover fre- 
quency can also increase the chance of the control system exciting the 
unmodelled modes (i.e. structural modes) and may lead to undesirably 



high control deflections. 


M 

A value of S ■ 1 was chosen for this prelim- 
inary investigation. Although the resulting loop transfer functions are 
not presented here* the cross-over frequencies for the chosen value of f 
were found to be quite fcig/t. (* fO rad/s) 

For the above problem formulation* the feedback gains obtained by 
exercising the solution algorithm are listed in Table 4.2. 

t 

4 . 3 Performance Evaluation 

For the control law synthesized as above, the transfer functions of 

interest for the augmented system are listed in Table 4.3. From the -jr 

and--- transfer functions* we note that unlike the DEA case. model reduc- 

* 

tion is required in order to get the low-order equivalent system parame- 
ters to determine the handling qualities of the augmented system. 

The desired frequency responses (from the model) and those for the 
augmented vehicle are compared in Figs. 4.2 to 4.4. Fig. 4.2 shows that 
the pitch rate frequency response for the vehicle closely approximates 
the model response for frequencies upto 10 rads/sec. Fig. 4.3 shows a 
fair agreement between the desired flight path angle response and that 
obtained at the center of rotation through augmentation. Fig. 4. 4 com- 
pares the resulting flight path angle to pitch attitude relationship 
with that desired. This last result is quite unsatisfactory and a 
redesign with higher control authority may be required in order to 
obtain a better fit between the model and the augmented vehicle. 

Time histories for a step pilot input (£^=1°) are shown in Figs. 

4.5 to 4.7. From the iX ) 0( } ^ and 0 responses in Fig. 4.5* we note that 
the augmented vehicle does exhibit "classical” aircraft like dynamics. 
The normal acceleration and the flight path angle response* both at the 
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C. G. as well as the C. R. * are shown in Fig. 4.6. The control deflec- 
tions for a step stick input are shown in Fig. 4.7. 

4 . 4 Robustness Evaluation 

Using the block diagram of Fig. 4. 1* the stability robustness of 
the EMF design may be evaluated by considering the values of j^-f- ky 
where Gf v (-6) z 8 V . The singular values of this return difference 

matrix for the design obtained above are shown in Fig. 4.8. Note that 
these stability margins are better than those obtained for the DEA 
design. If even higher stability margins are desired* then a control 
redesign with an appropriate choice of the control weighting matrix R 
may be required. 
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Figure 4.5 Augmented vehicle response for step pilot input 









Figure 4.7 Control Deflections for step pilot input (S^*\ 


o 

o 


o 


lx. 


3aru.iN.iww 











46 


5. IMPLEMENTATION USING PUT PU T F E5 PB A £& 

Both the synthesis algorithms discussed herein lead 
back control laws. Since 

not all the states of a system are measurable* an estimat 
required. Two issues that arise with estimation are the 
sient response and robustness. Two methods* which can be 
ment the full-state control laws* that are worthy of cons 
will be pursued further in the future* are cited here. 

5. 1_ Robust Kalman Fi Iter 

This procedure is as discussed in C7*83 and consists 
cally increasing the process noise in the Kalman filter s 
cedure till the full-state loop robustness is recovered, 
implemented* this procedure does not increase the dynamic 
stick-response transfer functions. 

5. 2 Robust Output Observers 

This procedure is as discussed in C93 and consists o 
observer theory to reconstruct system states from the ava 
ments. The advantages of this approach are that it leads 
and guaranteed stable controllers and the s ta te-f eedbac k 
reconstructed so there is no deterioration in performance 
ness. The procedure takes advantage of certain system str 
therefore cannot always be applied* however. 


to state feed- 
in practice* 
or design is 
effect on tran 
used to imple 
ideration and 


of parametri- 
ynthesis pro- 
Proper ly 
order of the 


f using 

ilable measur- 
to low order 
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and robust- 
ucture* and 
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fe. Cone lusions 

Some important conclusions based on the design examples addressed 
to date are as follows 

dea 

The direct eigenspace assignment technique has the advantage that 

* 

the resulting augmented system is of the same dynamic order as the 
open-loop system< which means that once the design is performed, the 
handling qualities evaluation of the augmented system can directly be 
carried out. Also, once the design requirements are properly mapped into 
the form of a desired eigenstruc ture. the solution algorithm for obtain- 
ing the “closest possible" eigenstructure for the augmented system is 
quite straightf orward. 

Some of the areas that require further investigation to make the 
DEA design technique more viable are 

a. Procedures for selecting the desired e i g enns true ture such that 
the choice reflects the control system design objectives. 

b. Procedures for improving the stability robustness of the feed- 
back design 

c. Prefilter design to properly blend the control inputs such 
that the desired dynamics are obtained from the pilot's stick 
input. 

EMF 

Though the EMF technique has the advantage that the flight 
control design requirements are easily mapped into the design pro— 
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cedure* its major disadvantages are that the resulting augmented 
system is of high order and the required bandwidth may be high. 
This means that system reduction is required in order to evaluate 
the handling qualities of the augmented system. This needs to be 
done for the control law synthesized herein. Finally* very high 
bandwidth control laws may be susceptible to model errors and 
require high deflection rates. 
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APPENDIX 

The macro for direct eigenspace assignment is listed in Table 
A. 1 and that for explicit model following in Table A. 2. Both the 
macros are written in the form of “user defined functions" and can 
be executed inside MATRIX^. Also* the macros are well documented 
with comment cards so that the user can understand the input— output 


requirements. 
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Table A. 1 Macro 'eigassgn' for DLA design 


t va* fbkrl=eigassgn(a* b< nc * nsp * 1 amc 1 * vd * qd) 
state feedback gains for eigenspace assignment 
inputs are a* b* nc# nsp* lame 1, vd< qd 
a — system matrix 

b - system control distribution matrix 
nc — no. of desired c omjp lex poles / 2 

nsp - no. of complex poles for which the weighting on the eigenvector 
error is different for real and imaginary parts 
lamcl — column vector of desired closed loop poles with nc+nr elements 
where nr is the no. of desired real poles 

first nc elements are the desired complex poles with +ve imag. part 
with the nsp elements appearing first 
n by (nc+nr) matrix of desired eigenvectors with ith column corr. to 
ith element of lamcl 

n by (nsp+nc+nr) matrix of weigthing on eigenvector errors* ith column 
forms the diagonal elements of the weigthing matrix of ith eigenvector 
the first 2#nsp columns correspond to the nsp eigenvectors with 
weighting on the real and imaginary parts appearing consecutively 
(the real part first) 
outputs are* va* fbkr 

va — matrix of acheivable eigenvectors 

fbkr — feedback gain matrix (corr. to neg. feedback) 


vd - 


qd - 


// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

// 

[tempi* t emp2] = s i z e ( 1 amc 1 ) » nr = tcmp 1-nc; 
ns=2#nc +nr* 

// 

if n5p>0* [ ns* nu 3=s i z e ( b ) * bb = Cb Ozones (ns* nu ) * 0*ones (ns* nu ) bl*... 

for i = l:nsp* j = 2*-i-l.- qtmp = d i ag ( C qd ( : * j ) * qd ( : * j + 1 ) D ) * . » . 

vtmp = [real(vd(: * i)); imag(vd(:* i))3* tmp l=r eal (lamcl (i) )*eye(ns)-a* . . . 

tmp2=ima g ( 1 amc 1 ( i ) )»ey e (ns ) ; mtmp = Ctmpl — tmp2* tmp2 tmpll; ... 

tmp=vtmp / *qtmp*inv(mtmp)*bb*inv(bb , #inv(mtmp) / *qtmp*inv(mtmp)*bb>* . . . 

vtmp = inv (mtmp ) -»b b#tmp '» tmp = tmp 7 » w( : * j ) = tmp ( 1 : nu ) + jay *tmp (nu+1 : 2*nu )i ... 

w(:* j + l)=conj(w(:* j)>« va(:*j)=vtmp(l:ns) + jay*vtmp(ns+l: 2*ns ) * ... 

vat: * j + 1 )=conj (va(: * j));... 

if i=nsp* clear qtmp bb tmp tmpl tmp2 mtmp vtmp nu; 

// 

tmp l=nc-nsp * 

if tmpl>0* for i=nsp + l:nc» j=2*i-l» 1 i = inv ( lame 1 ( i ) *ey e (ns ) -a ) *b; ... 
tmp=vd (: » i) '*diag(qd(:*nsp + i))*li*inv(li'*diag(qd(: *nsp + i))*li)j. . . 
w(:,j)=tmp / * w( : , j + 1 )=c on j (w( : * j ) ) * va ( : » j ) = 1 i*w( : * j ) » va < : * j+1 )=c on j (va ( : * j > ) 
if nr>0, for i = l:nr* j = 2*nc + i» l=nc + i* 1 i = inv ( lame 1 ( 1 ) #ey e (ns )-a )*b» ... 
tmp=vd (: * 1) '*diag(qd(: *nsp + l))*li*inv(li / *diag(qd(: *nsp + l))*li); . . . 

w(:*j) = tmp'* va ( : * j ) = 1 i*w( : , j ) » 

// 

f b k=-w*inv ( va ) » f b kr=r eal ( f b k ) * 
r etf 


I 


it I ; v- 
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| ^ a b 1 e A. 2 Macro 'fcomf' for L Mf d (? sign 

I // [ eva 1* kr< saug . num3=fcemf(sv. sm. tp, qe z » r , hv) 

// flight control explicit model following algorithm 

I // inputs are sv» sm. tp, qez. r< hv 
// sv — vehicle system. = tav bv; cv 03 
// sm - model system; = Cam bm; cm 03 

I // tp — pilot stick time constant 

// qez - weighting matrix for error between vehicle and model outputs 
// r — control weighting matrix 

I // hv — matrix of vehicle outputs for which transfer functions are desired 
// outputs are eval. kr» num 
// eval — closed loop eigenvalues 

// kr — state feedback gains corr. to neg. feedback 

I // saug — augmented system; pilot stick as input and augmnetd vehicle outputs 
// num — numerator coeff. of augmented vehicle output transfer functionss 
// (ith row corr. to ith output) 

I " 

Cny. nv3 = size(hv); 

Ctl. t23=size(sv); nu~- 1 2 -nv; nz = tl-nv; Ct3. nml3=size(sm);nm=nml— 1; 

I a = Csv(l:nv. 1: nv) 0*ones(nv, nml ); 0*ones(nm,nv) sm(l:nm.l:nml); 

O*ones < 1 . nv+nm ) . -l/tp3; b=Csv<l:nv, (nv+l):t2); O*ones (nml . nu ) 3; 

c = Csv( (nv+1 ): 1 1 » 1: nv). -sm ( nml : t3, 1: nm) Ozones < n z . 1)3; 
q=c '*qe z *c ; 

\" 

■ Ceval. kr3=regulator(e, b. q. r); 
temp=a-b*kr; eval=eig(temp); 

I " 

t4=nm+n v; 

aaug=temp(l: t4, 1: t4); baug=temp(l: t4, t4+l ); 

I caug = Chv 0* one s ( ny . nm ) 3; saug = C aa ug baug; caug Ozones (ny. 1 ) 3; 

Cnum. den3=tf orm( saug. t4); 
r etf 


